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Abstract 


A stereoscopic optical system images a stereoscopic picture image, a stereoscopic image processing 
section calculates a three-dimensional distance distribution from the stereoscopic picture image, and an 
object recognizing section recognizes objects from the distance distribution information to calculate a 
relative position of the objects with respect to the vehicle. On the other hand, a travelling amount of the 
vehicle is detected by a steering sensor and a rear wheel rotation sensor. Then, an object positional j 
information calculating section calcuLates a new relative position of the objects based on the relative 
position information memorized in a memory section and the calculated travelling amount of the vehicle and 
the memory section memorizes the new positional information. And, a bumping judgment outputting section 
judges the possibility of bumping against the objects based on the new relative position of the objects with 
reference to memorized information about the external shape of the vehicle. If it is judged therein that there 
is a possibility of bumping, the bumping judgment outputting section outputs a warning signal to an 
indicating section 
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® Objekterkennungsvorrichtung und -verfahren fur Fahrzeuge 

© Objekterkennungsvorrichtung fur ein Fahrzeug zum Er- 
kennen von urn das Fahrzeug angeordneten Objekten, mit 
einer Objekterfassungseinrichtung zurn Erfassen einer 
Richtung von Objekten und einer Abstandsverteitung zu 
den Objekten und einer Objekterkennungseinrichtung 
zum Erkenhen der durch die Objekterfassungseinrichtung 
erfaftten Objekte als Hindernisse basierend auf der Ab- 
standsverteilung und zum Berechnen einer Relativpositi- 
on der Objekte bezuglich des Fahrzeugs, wobei die Ob- 
jekterkennungsvorrichtung ferner aufweist: 
eine Objektpositionsspeichereinrichtung zum Speichern 
der Relativpositiqn der Objekte bezuglich des Fahrzeugs; 
eine Einrichtung zum Berechnen eines Fahrwerts, der 
eine Fahrtstrecke und eine Fahrtrichtung des Fahrzeugs 
enthalt, wobei der Fahrwert basierend auf einem Lenk- 
winkel und der Radumlaufzahl, basierend auf der Umlauf- 
zahl des linken und des rechten Hinterrades und/oder ba- 
sierend auf der Radumlaufzahl und einer um einen Winkel 
verschwenkbaren Objekterfassungseinrichtung ermittel- 
bar ist; und 

eine Einrichtung zum Berechnen von Objektpositionsin- 
formationen zum Berechnen einer neuen Relativposition 
der Objekte bezuglich des Fahrzeugs basierend auf der 
Relativposition der Objekte und dem Fahrwert des Fahr- 
zeugs und zum Aktualisieren der in der Objektpositions- 
speichereinrichtung gespeicherten Relativposition durch 
die neue Relativposition der Objekte, um die Objekte er- 
kennen zu konnen, die einen Erfassungsbereich der Ob- 
jekterfassungseinrichtung verfassen haben. 
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Beschreibung 

Die vorliegende !.:rhndung betrifift eine Objekterken- 
nungsvorrichtung und cin Objekterkennungsverfahren fur 
ein Fahrzeug und insbesondere eine Objekterkennungsvor- 
richtung und ein Objekierkennungsverfahren, die fur ein 
Fahrtunterstutzungssystem eines Automobils oder fur ein 
Steuerungssystem fur einen autonomen Fahrbetrieb eines 
autonom oder selbstandig fahrenden Fahxzeugs verwendet 
werden. 

Um ein sichereres Fahr- oder Betriebsgefuhl eines Fahr- 
zeugfuhrers bei einer Fahn durch enge StraBen mit haufig 
auftretenden Hindemissen, wie beispielsweise Wanden, 
Pfahlen, Stangen oder Lichlmasten, Leitschienen, geparkten 
Fahrzeugen und ahnlichen Hindemissen, zu gewahrleisten, 
wurde eine Vorrichtung zum Erfassen solcher Hindernisse 
durch Tastsensoren, wie beispielsweise ein Eckenstabfuhier, 
ein Kontaktschalter und ahnliche Einrichtungen, die auf ei- 
nem Fahrzeug angeordnet sind, entwickelt. 

AuBerdem wurde ein Verfahren entwickelt, bei dem Ul- 
traschaUsensoren auf einer Seitenflache oder an Ecken des 
Fahrzeug s angeordnet sind, um einen Abstand zu einem 
Hindernis zu messen und einen Fahrzeugfuhrer uber den ge- 
messenen Abstand zu informieren. 

AuBerdem wurde in den letzten Jahren ein Verfahren vor- 
geschlagen, gemaB dem nicht nur ein Abstand zu einem 
Hindemis erfaBt, sondern auch die Gestalt bzw. Form des 
Hindernisses erkannt wird. A Is Bei spiel eines solchen Ver- 
fahrens wird durch den vorliegenden Anmelder in der offen- 
gelegten Japanischen Patent veroffentlichung Nr. 5-114099 
eine Hindemiserkennungsvorrichtung beschrieben, bei der 
mehrere CCD-Kameras und eine Stereoskopbildverarbei- 
tungseinrichtung zum Erkennen von um das Fahrzeug vor- 
handerien Hindemissen verwendet werden, um den Fahr- 
zeugfuhrer zu informieren. Dieses Hindemiserkennungssy- 
stem kann nicht nur eine Richtung und eine Form eines Hin- 
dernisses erkennen, sondem auch einen exakten Abstand 
zum Hindemis bestimmen. 

Bei autonom oder selbstandig fahrenden Fahrzeugen 
wird, um wahrend der Fahrt eine Kollision oder einen Kon- 
takt mit Hindemissen zu vermeiden, ein Verfahren ange- 
wendet, gemaB dem das Vorhandensein bzw. das Nichtvor- 
handensein von Hindemissen unter Verwendung eines Infra- 
rotsensors oder eines Ultraschallsensors erfaJ3t wird, wobei, 
wenn ein Hindemis vorhanden ist, eine Steuerung, wie bei- 
spielsweise eine Steuerung zum Anhalten des Fahrzeugs, 
ausgefuhrt wird. 

AuBerdem konnen gemaB einer kurzlich vorgeschlagenen 
intelligenten Steuerung fiir einen autonomen Fahrbetrieb fiir 
ein Fahrzeug, bei der die vorstehend erwahnte Stereoskop- 
bildverarbeitungseinrichtung zum Erkennen von in der 
Nahe des Fahrzeugs vorhandenen Hindemissen verwendet 
wird, mehrere Hindernisse gleichzeitig erfaBt werden, um 
die Richtung und die Gestalt oder Form dieser Hindernisse 
zu erkennen und auBerdem verschiedartige Steuerungen, 
z. B. eine Steuerung zum Anhalten des Fahrzeugs oder zum 
Steuem des Fahrzeugs in die Richtung, in der kein Hinder- 
nis vorhanden ist, auszufuhren. 

Bei der vorstehend erwahnten Hindemiserkennungsvor- 
richtung, bei der Stereoskopkameras verwendet werden, tritt 
jedoch das Problem auf, daB, weil sie nur Hindernisse erken- 
nen kann, die in ein Sichtfeld der Kameras komrnen, z. B., 
Kameras, deren Linsen in Vorwartsrichtung des Fahrzeugs 
ausgerichtet sind, nur im Sichtfeld der Kameras vorhandene 
Objekte erkannt werden konnen, Objekte auBerhalb des 
Sichtfeldes jedoch nicht. 

Daher besteht, wenn das Fahrzeug eine Kurve fahrt bzw. 
eine Drehung ausfuhrt, die Moglichkeit, daB das Fahrzeug 
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mil. einem an' der Ecke stehenden Hindemis kollidiert. Upa 
ciies zu verhindern, konnten leicht zusaizliche Kameras in- 
sialliert werden, um an beiden Seiicn des Fahrzeugs ange- 
ordnete Hindernisse zu erfassen, wohci diese Idee jedoch 
5 nicht geeignet ist, weil zusatzlicht: Kameraposiiionen vorge- 
sehen sein miissen und die Kosten /.unchmen. 

Insbesondere im Fall, eines autonom fahrenden Fahr- 
zeugs, z. B. eioes unbemannten Bodenreinigungsfahrzeugs, 
das Bodenreinigungsarbeiten ausfuhn, isi es haufig erfor- 
10 derlich, einen genauen Arbeitsvorgang uin ein Hindemis 
auszufuhren. D. h., das Fahrzeug muB in der Lage sein, je- 
des umdas Fahrzeug angeordnete Hindernis zu erkennen. In 
diesem Fall ist es aus dem gleichen Grand, wie im vorste- 
hend erwahnten Fall, unzulassig, zusaizliche Kameras oder 
15 ahnliche Einrichtungen zu installieren. 

Aus der DE-A-43 08 776 ist ein System zur Uberwa- 
chung des fahrzeugextemen Zust.ands bekannt, bei dem die 
Distanz zwischen einem fahrenden Fahrzeug und einem Ob- 
jekt uber eine abgebildete Darstellung bestimmt wird. Dabei 
20 werden dreidimensionale Objekte oder die StraBenform mit 
Position oder Ausdehnung ebenfalls erfaBt: Ein Objekt in- 
nerhalb einer festen Region auBerhalb eines Fahrzeugs wird 
mittels eines opdschen Stereoskopsy stems abgebiidet, das 
einer Bi Id verarbeitungsvorrichtung das aufgenommene Bild 
25 zufuhrt, die eine Distanzverteilung Liber das gesamte Bild 
berechnet. Eine dreidimensionale StraBen-/Objektdetektor- 
vorrichtung berechnet dreidimensionale Positionen jeweili- 
ger Objektabschnitte entsprechend der Distanzverteilung s- 
information, um die Form der StraBe und mehrere dreidi- 
30 mensionale Objekte unter Verwendung der dreidimensiona- 
len Positionen zu berechnen. 

Aus der DE-C-41 10 132 so wie den Veroffentlichungen 
"Towards Ail Around Automatic Visual Obstacle Sensing 
for Cars" und "3-D Image Recognition System by Means of 
35 Stereoscopy Combined with Ordinary Image Processing" 
sind weitere diesbezugliche Systeme bekannt. 

Daher ist es eine Aufgabe der vorliegenden Erfindung, 
eine Objekterkennungs vorrichtung bereitzustellen, durch 
die Objekte um das Fahrzeug uber einen weiten Bereich er- 
40 faBt werden konnen, ohne daB zusatzliche Kameras, Ultra- 
schailsensoren oder andere komplizierte Objekterfassungs- 
vorrichtungen verwendet werden. Diese Aufgabe wird 
durch die Merkmale der Paten tanspriic he gelost. 

Die Erfindung wird nachstehend unter Bezug auf die bei- 
45 gefugten Zeichnungen beschrieben; es zeigen: 

Fig. 1 ein Funktionsblockdiagramm eines Fahrtunterstut- 
zungssystems, bei dem eine erste Ausfuhrungsform einer er- 
findungsgemaBen Objekterfassungsvbrrichtung verwendet 
wird; 

50 Fig. 2 eine schematische Seitehansicht zum Darsteilen 
des Gesamtaufbaus eines Fahrtunterstutzungssystems, bei 
dem die erste Ausfuhrungsform einer erfindungsgemaBen 
Objekterfassungs vorrichtung verwendet wird; 

Fig. 3 eine schematische Draufsicht zum Darsteilen des 

55 Gesamtaufbaus eines Fahrtunterstutzungssystems, bei dem 
die erste Ausfuhrungsform einer erfindungsgemaBen Ob- 
jekterfassungsvorrichtung verwendet wird; 

Fig. 4 eine Ansicht zum Erlautem von bei der ersten Aus- 
fuhrungsform der vorliegenden Erfindung verwendeten Po- 

60 sitionsinformationen uber um das Fahrzeug angeordnete 
Objekte; 

Fig. 5 eine Ansicht zum Erlautem einer gemaB der ersten 
Ausfuhrungsform der vorliegenden Erfindung erfaBten Po- 
sitionsanderung eines Objekts; 
65 Fig. 6 eine Ansicht zum Darsteilen von bei der ersten 
Ausfuhrungsform der vorliegenden Erfindung vorgesehenen 
Gefahrennaherungslinien; 

Fig. 7 ein Ablaufdiagramm einer ersten Ausfuhrungsform 
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eines erfimiungsgemaBen Fahrtunterstiitzungssysiems; 

Fig. 8 cin Funktionsblockdiagramm einer zweiien Aus- 
fuhrungslonn eines erfindungsgemaBen Fahnunterstut- 
zungssysiems: 

Fig. 9 cine schematise he Seitenansicht zum Darstellen 5 
des Gesamtaurbaus eines Fahrtunterstutzungssysrenis, bei 
dem einc /.weile Ausfuhrungsform einer erfindungsgema- 
Ben Objekterfassungsvorrichtung verwendet wird; 

Fig. 10 eine schematische Draufsicht zum Darslellen des 
Gesamtaufbaus eines Fahrtunterstiitzungssysiems, bei dem 10 
eine drittc Ausfuhrungsform einer erfindungsgemaBen Ob- 
jektertassungsvorrichtung verwendet wird; 

Fig. 1 1 ein Ablaufdiagramm der zweiten Ausfuhrungs- 
form eines erfindungsgemaBen Fahrtunterstiitzungssy stems; 

Fig. 12 ein Funktionsblockdiagramm eines Steuerungssy- 15 
stems ftir einen autonomen Fahrbetrieb, bei dem die dritte 
Ausfuhrungsform einer erfindungsgemaBen Objekterfas- 
sungsvorrichtung verwendet wird; 

Fig. 13 eine schematische Seitenansicht zum Darslellen 
des Gesamtaurbaus eines Steuerungssy stems fur einen auto- 20 
nomen Fahrbetrieb, bei dem die dritte Ausfuhrungsform ei- 
ner erfindungsgemaBen Objekterfassungsvorrichtung ver- 
wendet wird; 

Fig. 14 eine schematische Draufsicht zum Darstellen des 
Gesamtaufbaus eines Steuerungssy stems fur einen autono- 25 
men Fahrbetrieb, bei dem die dritte Ausfuhrungsform einer 
erfindungegemaBen Objekterfassungsvorrichtung verwen- 
det wird; 

Fig. 15 eine Ansicht zum Erlautern von bei der dritten 
Ausfuhrungsform der vorliegenden Erfindung verwendeten 30 
Positions infonnationen von um ein Fahrzeug angeordneten 
Objekten; 

Fig. 16 ein Ablaufdiagramm fur die dritte Ausfuhrungs- 
form eines erfindungsgemaBen Steuerungssy stems fur einen 
autonomen Fahrbetrieb; 35 

Fig. 17 ein Funktionsblockdiagramm einer vierten Aus- 
fuhrungsform eines erfindungsgemaBen Steuerungssy stems 
fiir einen autonomen Fahrbetrieb; 

Fig. 18 eine schematische Seitenansicht zum Darstellen 
des Gesamtaufbaus eines Steuerungssy stems fur einen auto- 40 
nomen Fahrbetrieb, bei dem eine vierte Ausfuhrungsform 
einer erfindungsgemaBen Objekterfassungsvorrichtung ver- 
wendet wird; 

Fig. 19 eine schematische Draufsicht zum Darstellen des 
Gesamtaufbaus eines Steuerungssys terns fur einen autono- 45 
men Fahrbetrieb, bei dem eine vierte Ausfuhrungsform ei- 
ner erfindungsgemaBen Objekterfassungsvorrichtung ver- 
wendet wird; 

Fig. 20 eine Ansicht zum Erlautern von bei der vierten 
Ausfuhrungsform der vorliegenden Erfindung verwendeten 50 
Positionsinformationen von um ein Fahrzeug angeordneten 
Objekten; und 

Fig. 21 ein Ablaufdiagramm der vierten Ausfuhrungform 
eines erfindungsgemaBen Steuerungssystems fur einen auto- 
nomen Fahrbetrieb. 55 

Fig. 2 und 3 zeigen ein motorbetriebenes Fahrzeug 1 mit 
einem Fahrtunterstutzungssystem 2 zum Unterstutzen eines 
Fahrers hinsichtlich der Beurteilung der Moglichkeit eines 
ZusammenstoBes des Fahrzeugs mit Hindernissen auf einer 
StraBe, wie beispielsweise Seitenwanden, Leitschienen, 60 
Stangen, Pfahlen oder Lichtmasten, geparkten Autos und 
ahnlichen Hindernissen, und zum Darstellen des Ergebnis- 
ses dieser Beurteilung fiir den Fahrer. 

Das Fahrtunterstutzungssystem 2 weist auf: ein stereo- 
skopisches optisches System 3 zum Aufnehmen von in ei- 65 
nem vorgegebenen Bereich auBen angeordneten Objekten, 
einen Lenkwinkelsensor 4 zum Erfassen eines Lenkwinkels, 
einen Hinterrad-Drehzahlsensor 5 zum Erfassen der Dreh- 



zahl eines Hinterrads. cine Sieuerungsvorrichtung 6, durch 
die beurteilt wird, ob einc cnge StraBe durchfahren werden 
kann, oder die Moglichkeii einer Kollision mit Hindernissen 
besteht, und einen Anzeigeabschnitt 7, durch den ein Fahr- 
zeugfuhrer uber das Hrgebnis der Beurteilung inform i err 
wird. 

Das stereoskopische optische System 3 besteht aus einein 
Paar CCD-Kameras 3L, 3R (eine linke bzw. eine rechte Ka- 
mera), die in einem vorgegebenen Abstand an der Decke im 
vorderen Abschnitt des Fahrgastraum angeordnet sind, um 
Stereoskopbilder von Objekten auBerhalb des Fahrzeugs 
aufzunehmen. 

Die Steuerungsvorrichtung 6 weist eine Fahrzeug-Run- 
dumobjekterkennungsvorrichtung 10 und einen Abschnitt 
20 zum Ausgeben des Ergebnisses einer Kollisionsbeurtei- 
lung auf. Im Objekterkennungsabschnitt 10 werden Positi- 
onsinformationen uber urn das Fahrzeug angeordnete Ob- 
jekte basierend auf dem durch das stereoskopische optische 
System 3 aufgenommenen Bild, dem durch den Lenksensor 
4 erf aB ten Lenkwinkel und der durch den Hinterrad-Dreh- 
zahlsensor 5 erfaBten Hinterrad-Drehzahl berechnet, und im 
Abschnitt 20 zum Ausgeben des Ergebnisses einer Kollisi- 
onsbeurteilung wird die Moglichkeit einer Kollision mit 
Hindernissen basierend auf den von der Fahrzeug-Rundum- 
objekterkennungsvorrichtung 10 erhaltenen Positionsinfor- 
mationen von Objekten, falls erforderlich, ausgegeben. 

Der Anzeigeabschnitt 7 besteht aus mehreren lichtemit- 
tierenden Objekten, wie beispielsweise elektrischen Lam- 
pen oder Leuchtdioden. Da von bezeichnen die Bezugszei- 
chen 7FL und 7FR einen an der Oberseite des linken bzw. 
des rechten Kotflugels der Fahrzeugkarrosserie angeordne- 
ten Anzeigeabschnitt. Die Bezugszeichen 7IL und 7ER be- 
zeichnen einen im Armaturenbrett bzw. in der Instrumenten- 
tafel angeordneten Anzeigeabschnitt, und Bezugszeichen 7S 
bezeichnet einen in der Nahe des Seitenspiegels an der Bei- 
fahrerseite angeordneten Anzeigeabschnitt. Diese Anzeige- 
abschnitte werden gemaB Ausgangssignalen vom Abschnitt 
20 zum Ausgeben des Ergebnisses einer Kollisionsbeurtei- 
lung aktiviert. Sie sind beispielsweise so aufgebaut, daB eine 
rote Lampe flimmert oder eingeschaltet wird, wenn festge- 
stellt wird, daB eine Kollision auftreten wird, eine gelbe 
Lampe flimmert oder eingeschaltet wird, wenn festgestellt 
wird, daB eine Kollision in Abhangigkeit von der zukiinfti- 
gen Lenkungsbetatigung des Fahrers auftreten kann, und 
eine griine Lampe eingeschaltet ist, wenn festgestellt wird, 
daB zwischen dem Fahrzeug und Objekten geniigend Raum 
vorhanden ist bzw. keine Kollisionsgefahr besteht. 

Die Fahrzeug- Rundumobjekterkennungsvorrichtung 10 
weist fern er einen Stereoskopbildverarbeitungsabschnitt 11, 
einen Objekterkennungsabschnitt 12, einen Abschnitt 13 
zum Berechnen von Objektpositionsinformationen und ei- 
nen Speicherabschnitt 14 auf. 

Im Stereoskopbildverarbeitungsabschnitt 11 wird eine 
Abstandsinformation gernaB einem Triangulationsprinzip 
aus einem Gesamtbild erhalten, das aus einem Paar durch 
das stereoskopische optische System 3 aufgenommenen Ste- 
reoskopbilder besteht, werden Abstandsbilder, die dreidi- 
mensionale Abstandsverteilungen aufweisen, basierend auf 
dieser Abstandsinformation gebildet und diese Abstandsbil- 
der an den Objekterkennungsabschnitt 12 ausgegeben. Da- 
her wird durch das stereoskopische optische System 3 und 
den Stereoskopbildverarbeitungsabschnitt 11 eine Objekter- 
fassungseinrichtung gebildet. 

Im einzelnen werden im Stereoskopbildverarbeitungsab- 
schnitt 11 die Abstandsverteilungen durch Aufnnden einer 
Ubereinstimmung von Helligkeits- oder Farbmustern zwi- 
schen dem linken und dem rechten Bild fiir jeden kleinen 
Bereich erhalten, durch die ein vorgegebenes Bild gebildet 
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wird. Wenn das "i '-tc Bildelement des linken und des rech- 
ten Bildes als Aj b/w. B, dargestellt wird (beziiglich der He!- 
ligkeit oder der Farbe). wird die Bestimmung der Uberein- 
stimmung zwischen dem linken und dem rechten Bild basie- 
rend auf dem folgenden City-Blockab stand H durchgefuhrt. 
D. h., es wird festgesiellt, daB der linke und der rechte kleine 
Bereich miteinander iibereinstimmen, wenn der Minimal- 
wert des City-Bloekabsiands H eine vorgegebene Bedin- 
gung erfiillt. 

H = LIAi-Bil (1) 

Die Abstandsveneilungsinformation, d. h. die Abstands- 
bilder, sind in einer vorgegebenen GroBe des Bildes (z. B. 
400 X 200 Bildelementen) in einem Koordinatensystem an- 
geordnet. In diesem Beispiel hat das Koordinatensystem ei- 
nen Ursprung an der linken oberen Ecke, wobei eine "i"- 
Achse in Querrichtung und eine "j"-Achse in Langsrichtung 
angeordnet sind. 

Der Objekterkennungsabschnitt 12 ist eine Objekterken- 
nungseinrichtung zurn Extrahieren mehrerer vor dem Fahr- 
zeug angeordneter Objekte aus dem Abstandsbild, zum Be- 
rechnen der Position und der GroBe jedes Objekt und zum 
Erzeugen eines Bildes einer Grenz- oder UmriBlinie des Ob- 
jekts. Beim Extrahieren eines Objekts wird basierend auf ei- 
ner Hohenin formation in den dreidimensionalen Positions- 
daten des Objekts unterschteden zwischen dem Objekt und 
der StraBe, und durch die Abstandsinformation wird das Ob- 
jekt vom Hintergrund getrennt. Weil diese Hohen- oder Ab- 
standsinformationen aus einem Bezugskoordinatensystem 
erhalten werden, wird zunachst das Koordinatensystem im 
Stereoskopbildverarbeitungsabschnitt 11 in ein neues Koor- 
dinatensystem im realen Raum oder Realraum um das Fahr- 
zeug 1 transformiert. 

Dieses praktische Koordinatensystem im Realraum wird 
durch orthogonale Koordinaten gebildet, deren Ursprung 
auf die Mitte des Fahrzeugs 1 festgelegt ist (exakt auf einen 
Punkt der StraBenoberflache unmittelbar unter der Fahr- 
zeugmitte), wobei die X-Achse des Koordinatensys terns in 
Seiten- oder Querrichtung des Fahrzeugs 1, die Y-Achse in 
Langsrichtung des Fahrzeugs und die Z-Achse in vertikaler 
Richtung des Fahrzeugs ausgerichtet ist. In diesem Fall 
stimmt die X-Y-Ebene (Z = 0) mit der StraBenoberflache 
uberein, vorausgesetzt, daB die StraBe eben ist. Um die drei- 
dimensionale Position (X, Y, Z) eines Objekts im Realraum- 
koordinatensystem aus der Abstandsinformation (i, j) im 
Bild zu berechnen, wird gemaB den folgenden Gleichungen 
(2) und (3) eine Koordinaten transformation durchgefuhrt. 

Z = CH - Y x PW x (j - JV) (2) 

X = r/2 - p + Y x PW x (i - IV) (3) 

wobei 

CH: Hohe der Kameras 

PW: Sichtwinkel je Bildelement 

IV: i-Koordinate eines unendlich entfernten Punktes in Ge- 
radeausrichtung vor dem Fahrzeug 1 

JV: j-Koordinate eines unendlich entfernten Punktes in Ge- 

radeausrichtung vor dem Fahrzeug 1 

r: Abstand zwischen den beiden Kameras 

p: Abweichung des Mittelpunktes der beiden Kameras von 

der Fahrzeugmit.te 

Umgekehrt wird die Abstandsinformation (i, j) im Bild 
aus der dreidimensionalen Koordinate (X, Y, Z) des Real- 
raumkoordinatensystems gemaB den folgenden Gleichun- 
gen (4) und (5) berechnet, die durch Transformation der 
Gleichungen (2) und (3) erhalten werden. 



j = (CH - Z)/(Y x PW) + JV (4) 
i = (X - r/2 + p)/(Y x PW) + IV (5) 

5 

AuBerdem wird im Objekterkennungsabschnitt 12, wie 
nachstehend beschrieben wird. eine "Objekterkennung", wie 
beispielsweise die Erkennung von Ilindernissen, z. B. von 
geparkten Automobilen, getrenni von einer "Wanderfas- 

io sung", z. B. der Erfassung von vSeiienwanden an der Stra- 
Benseite, durchgefuhrt. Bei einer "Objekterkennung" wird 
nur ein Objekt aus den Abstandsbilddaten vom Stereoskop- 
bildverarbeitungsabschnitt 11 ausgewahlt, das die Fahrt des 
Fahrzeug behindem kann. Das Absiandsbild wird in vertika- 

15 ler Richtung in mehrere Abschnitle unterteilt. Die Breite ei- 
nes Abschnitts betragt 8 bis 20 Bildelemente. Bei dieser 
Ausfuhrungsform werden, weil 400 Bildelemente in der 
Seitenrichtung angeordnet sind, in einem Bild 20 bis 50 Ab- 
schnitte gebildet. Im Objekterkennungsabschnitt 12 konnen, . 

20 weil fiir jeden Abschnitt Objekte erfaBt werden, mehrere 
Objekte gleichzeitig erfaBt werden. Daraufhin wird auch der 
Abstand zu den erfaBten Ob jekt en berechnet. 

Beziiglich den Objekten jedes Abschnitts wird aus der 
Koordinate (i, j) des Bildes und dem Abstandsdatenelement 

25 Y unter Verwendung der vorstehenden Gleichungen (2) und 
(3) eine dreidimensionale Position (X, Y, Z) eines Objekts 
im Realraum berechnet. Die Hohe H des Objektes beziiglich 
der StraBenoberflache wird gemaB der folgenden Gleichung 
berechnet: 

30 

H=Z-Zr (6) 

wobei % die Hohe der StraBenoberflache ist. Allgemein 
wird vorausgesetzt, daB 7^ - 0,0 m betragt, auBer fur den 

35 Fall, wenn das Fahrzeug gerieigt ist oder sich in vertikaler 
Richtung bewegt Wenn die Hohe des Objekt kleiner ist als 
etwa 0,1 m, wird angenornmen, daB das Objekt kein Hinder- 
nis ist, so daB die Daten des Objekts verworfen werden. Da- 
her werden Daten der StraBe selbst, von Fahrbahnmarkie- 

40 rungen, Schatten und ahnliche Daten aus den Bilddaten ge- 
loscht. Andererseits konnen Objekte, deren Hohe groSer ist 
als das Fahrzeug, verworfen werden, weil angenornmen 
wird, daB diese FuBgangerbriicken, StraBenschilder und 
ahnliche Einrichtungen sind. Daher werden nur Objekte aus- 

45 gewahlt, durch die die Fahrt behindert wird. Durch diese 
Verarbeitung der Hohendaten, konnen im zweidimensiona- 
len Bild der StraBe uberlagerte Objekte von der StraBe un- 
terschieden werden. 

Daraufhin wird beziiglich der Daten der derart extrahier- 

50 ten Objekte eines Abschnitts die Anzahl der in einem vorge- 
gebenen Abstand Y enthaltenen Daten gezahlt, und es wird 
ein Histogramm erzeugt, dessen Abszissenachse der Ab- 
stand Y ist. Der vorgegebene Abstand Y wird festgelegt, in- 
dem die Erfassungsgrenze, die Erfassungsgenauigkeit, die 

55 Form des Objektes und ahnliche Faktoren beriicksichtigt 
werden. 

Weil im derart erzeugten Histogramm fehlerhaft erfaBte 
Werte enthalten sind, erscheinen einige wenige Daten an ei- 
ner Position, wo tatsachlich kein Objekt vorhanden ist. Wo 

60 auch immer ein Objekt mit einer gewissen GroBe vorhanden 
ist, tritt an der Position, wo das Objekt vorhanden ist, eine 
groBe Haufigkeit von Datenpunkten auf. An Positionen, wo 
kein Objekt vorhanden ist, erscheint dagegen eine geringe 
Haufigkeit von Datenpunkten. 

65 Wenn daher die Haufigkeit bei einem bestimmten Ab- 
stand Y einen vorgegebenen Wert uberschreitet, wird festge- 
stellt, daB dort ein Objekt vorhanden ist. Wenn die Haufig- 
keit uber einen bestimmten Bereich kleiner ist als der vorge- 
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gebene Weri. ? wird lestgestellt, daB innerhalb dieses Bc- 
reichs kein Objeki vorhanden ist, wodurch ein nachtciliyer 
EinfluB durch Rauschen eliminiert werden kann. 

Wenn festgestelll wird, daB Objekte vorhanden sind, wird 
der Abstand Y zu dern Objekt durch Bilden eines Minelwer- 5 
tes der Abstandsdaten Y und der Daten in der Nahe von Y 
erhalten. Diese Verarbeitungen zum Erfassen von Objekt en 
und zum Berechnen des Abstands werden fur al)e Ab- 
schnitte ausgefuhrt. Wenn der Unterschied zwischen dein 
Abstand zu einem erfaBten Objekt in einern bestimmten Ab- 10 
schnitt und dem Abstand zu einem erfaBten Objekt in einem 
in der Nahe angeordneten Abschnitt kleiner ist als ein vorge- 
gebener Wert, wird angenommen, daB diese Objekte das 
gleiche Objekt darstellen. Wenn diese Differenz dagegen 
groBer ist als ein vorgegebener Wert, werden diese Objekte 15 
als verschiedene Objekte betrachtet. Daher kann, auch wenn 
mehrere Objekte einander uberlagert sind, ein unabhangiges 
Objekt durch die un terse hiediichen Abstande identifiziert 
werden. 

Nachstehend wird die Transformation der erfaBten Ob- 20 
jekte im dreidimensionalen Raum in den zweidimensionalen 
Raum beschrieben. Zunachst wird ein "dreidimensionales 
Fenster" eingerichtet, das die Objekte enthalt, und dann wird 
aus diesem "dreidimensionalen Fenster" ein "zweidimensio- 
nales Fenster" erzeugt. Im einzelnen werden zweidimensio- 25 
nale Koordinaten (i n , j^) unter Verwendung der vorstehen- 
den Gleichungen (4) und (5) beziiglich jedem von acht Eck- 
punkten (X n , Y n , Z n ) eines dreidimensionalen Fensters be- 
rechnet, und es werden Poly gone durch Umhiillen dieser 
zweidimensionalen Koordinaten (i n , jn) erzeugt. Dadurch 30 
werden UmriBlinien der Objekte aus den irri dreidimensio- 
nalen Fenster enthaltenen Daten extrahiert. 

Hinsichtlich der Wanderfassung im Objekterkennungsab- 
schnitt 12, wird die Seitenwand auf der StraBenseite durch 
den Hohenunterschied zwischen der Seitenwand und der 35 
StraBenoberflache yon der StraBe unterschieden. Die Seiten- 
wand wird- durch den Unterschied der Abstande in der Sei- 
ten- und in der Langsrichtung des Bildes vom fernen Hinter- 
grund unterschieden. 

D. h., es werden aus der Abstandverteilungsin formation 40 
zunachst nur Daten von Objekten extrahiert, die hoher sind 
als die StraBenoberflache, daraufhin werden daraus nur in 
einem vorgegebenen Suchbereich der Seitenwand vorhan- 
dene Daten der Seitenwand extrahiert, wenn die Seitenwand 
existiert, wobei ihre Position durch lineare Gleichungen 45 
durch Anwenden eines Huff-Transformationsverfahrens 
dargestellt wird. Basierend auf diesen linearen Gleichungen 
wird, indem ein Seitenwandexistenzbereich eingerichtet 
wird, in dem die Seitenwand vermutet wird, das nachste und 
das entfernteste Ende der Seitenwand von diesen Objektda- 50 
ten im Seitenwandexistenzbereich erfaBt. 

D. h., weil die Seitenwand auch ein Objekt ist, werden zu- 
nachst Daten von Objekten, die hoher sind als die StraBeno- 
beflache, aus dem Abstandsbild extrahiert. Daraufhin wer- 
den die Daten von Objekten, die niedriger sind als eine Hohe 55 
von etwa 0,1 m, verworfen, weil vorausgesetzt wird, daB 
diese Fahrbahnmarkierungen, Vers chmutzun gen, Schatten 
oder ahnliche Objekte auf der StraBe darstellen. AuBerdem 
werden Daten von Objekten, die hoher sind als die Hohe des 
Fahrzeugs, verworfen, weil diese als FuBgangerbrucken, 60 
Verkehrszeichen und ahnliche Einrichtungen betrachtet 
werden. Daher werden nur Objekte uber der StraBenoberfla- 
che ausgewahlt. 

Wenn die derart extrahierten Daten verarbeitet werden, 
wird, weil es nicht effizient ist, alle Daten im Bild zu verar- 65 
beiten, eine Grenze in einem Suchbereich festgelegt, in dem 
die Seitenwand gesucht werden soil. 

Allgemein sind die Seitenwande an der linken und der 
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rcchten Seite der StraBe parallel zum Fahrzeug 1 angeord- 
net. AuBerdem konnen Daten der weit vom Fahrzeug ent- 
rernten Seitenwand aus den erforderlichen Daten geloscht 
werden. Wenn dies berucksichtigt wird, werden zwei Such- 
bereiche an der linken bzw. der rechten StraBenseite einge- 
richtet, und die Erfassung wird getrennt fur jeden Suchbe- 
reich durchgefuhrt. 

AnschlieBend werden die zweidimensionalen Positionen 
(X-, Y- Koordinaten) der in jedem der Suchbereiche enthal- 
tenen Objekte berechnet. Weil die Daten in den Suchberei- 
chen nicht nur Daten der Seitenwand selbst, sondern auch 
Raten anderer Objekte en thai ten, sind auch Rauschdaten 
enthalten. Aus diesen verschiedenartigen Daten werden un- 
ter Verwendung des Huff-Transformationsverfahrens nur li- 
near angeordnete Daten extrahiert, und die UmriBlinie der 
Seitenwand wird erzeugt. 

Im einzelnen wird, wenn die Erf assung der linearen Glei- 
chung gemaB der Huff-Transformation zunachst beziiglich 
. einer Position (Xj, YO eines Objekts beschrieben wird, eine 
durch Pj verlaufende gerade Linie F^ vorausgesetzt. Die 
Gleichung der geraden Linie wird dargestellt durch: 

X = afiXY + bfi (7) 

AnschlieBend wird, wenn ein Parameterraum vorausge- 
setzt wird, durch den ein Gradient af und ein Achsenab- 
schnitt oder Abschnitt bf parametrisiert werden, eine Hau- 
figkeitsbestimmung der Kombination der Parameter af} und 
bfi beziiglich Pi (Xi, Yj) vorgenommen. 

Weil vorausgesetzt wird, daB die Seitenwand etwa paral- 
lel zum Fahrzeug 1 angeordnet ist, sollte der Wert des Gra- 
dienten a£ groB genug sein, z. B. im Bereich von ±20 Grad 
liegen. AuBerdem sollte der Wert des Abschnitts bfi -1 m bis 
-10 m an der linken StraBenseite und +1 m bis +10 m an der 
rechten StraBenseite betragen, weil die Erfassung einer weit 
vom Fahrzeug entfernten Seitenwand in der Praxis nicht er- 
f order lich ist. 

Durch diese Festlegung der Bereiche wird ein rechtecki- 
ger Bereich gebildet, in dem Haufigkeitsermittlungen vorge- 
nommen werden. AuBerdem wird dieser rechteckige Be- 
reich in mehrere Gitter unterteilt. Der Gradient afi von Glei- 
chung (7) wird um ein Gitterintervall Aaf innerhalb des vor- 
gegebenen Bereichs (z. B. ±20 Grad) geandert. Durch Erset- 
zen dieses Gradienten afj und der Koordinaten (X,, YJ der 
Objektdaten P* in Gleichung (7), wird der Wert des Ab- 
schnitts bfi erhalten. Wenn der derart erhaltene Wert bfj in- 
nerhalb des vorgegebenen Bereichs iiegt, wird fiir ein ent- 
sprechendes Gitter des Parameterraums ein Zahlwert vor- 
warts gezahlt. 

Die Positionsgenauigkeit der erfaBten Seitenwand, d. h. 
die Erfassungsgenauigkeit des Gradienten und des Ab- 
schnitts der linearen Gleichung, ist abhangig von Aaf und 
Abf. Bei der Bestimmung des Gitterintervalls von Aaf wird 
Abf unter Verwendung dieser Seitenwandinformation dem 
erforderlichen Pegel der Peripheriegerate angepaBt. 

Wenn als Ergebnis der Haufigkeitsermittlung im Parame- 
terraum Daten in einer geraden Linie angeordnet sind, ent- 
halt das den Parametern afj, bfj der geraden Linie entspre- 
chende Gitter einen hohen Zahlwert. Dadurch erscheint im 
linken und im rechten Haufigkeitsermittlungsbereich ein lo- 
kales Maximum. 

Wenn eine Seitenwand vorhanden ist, d. h., eine offen- 
sichtliche Anordnung von Objektdaten existiert, stellt das 
lokale Maximum einen groBen Wert dar. Wenn dagegen 
keine Seitenwand vorhanden ist, d. h., Objektdaten verstreut 
verteilt sind, stellt das lokale Maximum einen kleinen Wert 
dar. Daher kann festgestellt werden, ob eine Seitenwand 
vorhanden ist, indem erfaBt wird, ob der Wert des lokalen 
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Maximums groBer ist als ein vorgegebener Entscheidungs- 
wert. Dieser Entscheidungswert wird unter Berucksichti- 
gung der GroBe des Such bereichs, des Giuerintervalls und 
a h n lie her Faktoren festgelegt. 

AnschlieBend wird, wenn eine Seitenwand vorhanden ist, 
die Position des nachsten und des am weitesten entfernten 
Endes erfaBt. Zunachst wird ein Wandexistenzbereich durch 
eine gerade Linie festgelegt, enilang der eine Seitenwand 
vermutet wird. Der Wandexistenzbereich hat eine Breite von 
0,3 m bis 1,0 m, wobei die gerade Linie in der Mitte ange- 
ordnet ist. AuBerdem wird, nachdern dieser Bereich in der 
Y-Richtung in Scheiben unterteili wurde, die Anzahl der 
Objektdaten in der Scheibe vorwarts gezahlt, um ein Histo- 
gramm zu erstellen. Wenn eine Scheibe gefunden wird, in 
der die Haufigkeit groBer ist als ein vorgegebener Wert, wird 
festgestellt, daB in deren Nahe eine Seitenwand vorhanden 
ist. Daher wird die dreidimensionale Position fur alle Seiten- 
wande berechnet, und das nachste und das am weitesten ent- 
fernte Ende werden erfaBt. 

Bei den vorstehenden Verarbeitungen werden Parameter 
der Position von Objekten auf StraBen, der Form von Objek- 
ten und andere Parameter aus dem Abstandsbild gelesen und 
dem Abschnitt 13 zum Berechnen von Objektpositionsinfor- 
mationen zugefiihrt, der eine Einrichtung zum Berechnen 
von Objektpositionsinformationen bildet. 

Im Abschnitt 13 zum Berechnen von Objektpositionsin- 
formationen werden, nachdern die im Speicherabschnitt 14 
gespeicherten Objektpositionsinformationen aktualisiert 
wurden, basierend auf dem durch den Lenksensor 4 erfaBten 
Lenkwinkel, der durch den Hinterrad-Drehzahlsensor 5 er- 
faBten Drehzahl des Hinterrades und der vom Objekterken- 
nungsabschnitt 12 erhaltenen Information neue Positionsin- 
formationen von Objekten um das Fahrzeug berechnet. 

GemaB Fig. 4 sind die neuen Positionsinformationen von 
Objekten um das Fahrzeug Positionsinformationen inner- 35 
halb eines Bereichs QRST, die durch neu erhaltene Informa- 
tionen (Informationen innerhalb eines Bereichs PQR) vom 
Objekterkennungsabschnitt 12 und durch zuvor vom Ob- 
jekterkennungsabschnitt 12 erhaltene Informationen gebil- 
det werden. 40 

D. h., wenn das Fahrzeug eine Strecke M zuriickgelegt 
hat und neue Positionsinformationen des Bereichs PQR vom 
Objekterkennungsabschnitt 12 erhalten werden, werden die 
vorhergehenden Positionsinformationen eines Bereichs 
Q'R'ST* aktualisiert. In diesem Fall werden die aus dem 45 
Speicherbereich uberlaufenden Daten (Daten eines Bereichs 
TSST') und die (mit den neu erhaltenen Daten des Bereichs 
PQR uberlappenden) Daten eines Bereichs PEF geloscht 
und dann die neuen Positionsinformationen des Bereichs 
PQR hinzugefiigt. Die derart erhaltenen Daten der aktueDen 50 
Objektpositionsinformation werden wieder im Speicherab- 
schnitt 14 gespeichert und an den Abschnitt 20 zum Ausge- 
ben des Ergebnisses einer Kollisionsbeurteilung ausgege- 
ben. Fig. 4 zeigt anhand eines leicht verstandlichen Bei- 
spiels den Fall eines in Geradeausrichtung fahrenden Fahr- 55 
zeugs, wobei die aktuellen Objektpositionsinformationen je- 
doch auf ahnliche Weise erhalten werden konnen, wenn das 
Fahrzeug eine Kurve fahrt bzw. eine Drehung ausfuhrt. 

Daher konnen gemaB der im Zusammenhang mit der er- 
sten Ausfuhrungsform der vorliegenden Erflndung beschrie- 60 
benen Fahrzeug-Rundumobjekterkennungsvorrichtung 10, 
weil die Position eines Objekts auch dann bekannt ist, nach- 
dern dieses Objekt das Sichtfeld einer Kamera verlassen hat 
Objekte um das Fahrzeug in einem breiten Bereich erfaBt 
werden, ohne daB zusatzliche Kameras oder andere kompli- 65 
zierte Vorrichtungen erforderlich sind. 

Die neuen Objektpositionsinformationen werden gemaB 
nachstehenden Gleichungen aus den vorhergehenden Ob- 
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jekt positionsinformationen erhalten. 

GemaB Fig. 5 bewegtsich, wenn das Fahrzeug in Cicrade- 
ausrichiung fahrt, ein Objekt an einem Punkt A fx a . v d .) /.um 
Punkt B (x b , y b ). In diesem Fall ist, weil das Fahrzeug ge- 
5 radeaus fahrt, x a = x b . Wenn vorausgesetzt wird, daB- der 
Fahrwert des Hinterrades AM betragt, gilt y b = y a AM. Die 
durch (x 0 | d , y 0 i d ) dargestellte vorangehende Position ver- 
schiebt sich gemaB den folgenden Gleichungen zur durch 
(x ne w> Ynew) dargestellten neuen Position: 

10 

(8) 

Ynew = Yold - AM (9) 

15 AuBerdem verschiebt sich, wenn das Fahrzeug eine Dre- 
hung mit dem Punkt P (Xce, Y ce ) als Mittelpunkt ausfuhrt, 
der Punkt B (x b , y b ) zum Punkt (2 (x c , y c ). Wenn der Lenk- 
winkel durch 5 dargestellt wird, werden die Koordinaten des 
Punktes P c durch folgende Gleichungen dargestellt; 

20 

X CE =f(6) (.10) 
Y CE =0 (11) 

25 wobei f(5) ein unter Bezug auf eine vorgegebene Tabelle, 
durch die der Lenkwinkel 5 parametrisiert wird, erhaltener 
Wert ist. 

Der Drehwinkel 9 C bei Kurvenfahrt wird durch folgende 
Gleichung dargestellt: 

6 C = AM/(X CE - X w ) (12) 

wobei X w ein Offset- Wert des Hinterrades in X-Richtung 
bezug lie h der Kameraposition ist. 

Wenn das Fahrzeug eine Drehung um den Drehwinkel 9c 
ausfuhrt, verschiebt sich die vorhergehende Objektposition 
der Koordinate (x oW , y oId ) zur Koordinate (x ncw , y nc w) T die 
folgendermaBen berechnet wird: 

x cos(a + 6 C ) + X CE (13) 
J new — 4 x sin(a + 6 C ) + Y CE (14) 
wobei 

r = ((x old - X CE ) 2 + (y 0 id - Y CE ) 2 ) l/2 

a = arctan((y 0 i d - Y CE )/(Xoid - X CE )) 

Im Abschnitt 20 zum Ausgeben des Ergebnisses einer 
Kollisionsbeurteilung wird die Wahrscheinlichkeit einer 
Kollision mit einem Objekt basierend auf der derart erhalte- 
nen Objektpositionsinformation und einer gespeicherten In- 
formation uber die auBere Form des Fahrzeug s beurteilr, und 
das Beurteilungsergebnis wird an den vorstehend erwahnten 
Anzeigeabschnitt 7 ausgegeben. 

Wie in Fig. 6 dargestellt, sind an der linken und an der 
rechten Seite des Fahrzeugs eine linke Gefahrennaherungs- 
linie LA und eine rechte Gefahrennaherungs linie RA einge- 
richtet. Wenn das Objekt oder Hindernis innerhalb dieser 
Gefahrennaherungslinien LA und RA vorhanden ist, wird 
eine der Wamlampen 7FL, 7FR, 7IL und 7IR ausgewahlt, 
um ein rotes Licht einzuschalten. Wenn beispielsweise das 
Objekt an der linken Seite des Fahrzeugs vorhanden ist, 
leuchten die Warnlampe 7FL auf dem linken Kotfliigel und 
die Warnlampe 7IL auf der Instrumententafel bzw. dem Ar- 
maturenbrett auf. Wenn dagegen das Objekt an der rechten 
Seite des Fahrzeugs vorhanden ist, leuchten die Warnlampe 
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7FR auf dem rechten Koillugd und die Warnlampe 7IR aul 
der Instrurnententafel bzw. dern Armaturenbrett auf. 

Ferner sind eine linke Gefahrennaherungslinie LB und 
eine rechte Gefahrennaherungslinie RB auBerhalb der Ge- 
fahrennaherungslinien LA b/w. RA eingerichtet. Wenn das 
Objekt zwischen der Getahrennaherungslinie LA und der 
Gefahrennaherungslinie LB vorhanden ist, wird festgestellt, 
daB das Fahrzeug in Abhangigkeit von der Handhabung 
bzw. Bedienung des Fahrzeugs durch den Fahrer zukiinftig 
mit dem Objekt kollidieren kann, wobei ein geibes Licht in 
den Warnlampen 7FL und 7IL aufleuchtet. Wenn dagegen 
das Objekt zwischen der Getahrennaherungslinie RA und 
der Gefahrennaherungslinie RB vorhanden ist, leuchtet ahn- 
licherweise ein geibes Licht in den Warnlampen 7FR und 
7IR auf. 

AuBerdem wird, wenn das Objekt auBerhalb der Gefah- 
rennahrungslinien LB und RE vorhanden ist, festgestellt, 
daB zwischen dem Objekt und dem Fahrzeug ein geeigneter 
Abstand vorhanden ist, so daB keine Koliisionsgefahr be- 
steht. In diesem Fall wird in den Warnlampen 7FL und 7IL 
ein griines Licht eingeschaltet, usw. 

Im in Fig. 6 dargestellten Beispiel sind die Gefahrennahe- 
rungslinien LA, RA* LB und RB gerade, parallel zueinander 
verlaufende Linien, diese Linien mussen jedoch nicht not- 
wendigerweise gerade oder parallel verlaufen. Es kann eine 
beliebige Form von Linien oder Kurven ausgewahlt oder in 
Abhangigkeit von der Fahrzeuggeschwindigkeit oder dem 
Lenkwinkel verandert werden. 

Nachstehend wird die erste Ausfuhrungsform einer erfin- 
dungsgemaBen Fahrtunterstutzungssteuerung unter Bezug 
auf das in Fig. 7 dargestellte Ablaufdiagramrn beschrieben. 

Zunachst werden bei Schritt (nachstehend als S bezeich- 
net) 101 ein Lenkwinkel 8 und ein aus der Drehzahl des Hin- 
terrades berechneter Fahrwert des Hinterrades vom Lenk- 
winkelsensor 4 bzw. vom Hinterrad-Drehzahlsensor 5 gele- 
sen. AuBerdem wird gleichzeitig eine vorangehende Objekt- 
positionsinformation vom Speicherabschnitt 14 des Fahr- 
zeug-Rundumobjekterkennungsabschnitts 10 gelesen. 

Daraufhin schreitet das Prograrnm zu SI 02 fort, wo fest- 
gestellt wird, ob das Fahrzeug 1 eine Drehung ausfuhrt oder 
geradeaus fahrt. Wenn es geradeaus fahrt, schreitet das Pro- 
grarnm zu SI 03 fort, und wenn es eine Drehung ausfuhrt, 
schreitet das Prograrnm zu SI 04 fort. 

Wenn das Prograrnm zu SI 03 fortschreitet, wird die Ob- 
jektpositionsinformation durch Addieren eines Fahrwerts 
AM des Hinterrades zur neuen Objektpositionsinformation 
verschoben. (vergl. Gleichungen (8) und (9)). 

Wenn das Prograrnm dagegen zu S104 fortschreitet, wer- 
den der Drehmittelpunkt P c und der Drehwinkel 6 C basie- 
rend auf dem Lenkwinkel 5 und dem Fahrwert AM des Hin- 
terrades gemaB den Gleichungen (10), (11) und (12) berech- 
net, und beim nachsten Schritt S105 wird die vorangehende 
Objektpositionsinformation so weit gedreht, wie dem Dreh- 
winkel 6 C um den Drehmittelpunkt P c entspricht. Im einzel- 
nen wird die durch die Koordinaten (x ncw > Ynew) dargestellte 
neue Objektpositionsinformation gemaB den Gleichungen 
(13) und (14) berechnet. 

Das Prograrnm schreitet von SI 03 oder SI 05 zu SI 06 
fort, wo die durch die Verarbeitung bei S103 oder S105 aus 
dem Speicherbereich uberlaufenden Daten geloscht werden. 

AnschlieBend schreitet das Prograrnm zu SI 07 fort, wo 
die mit den neu erhaltenen Objektpositionsinformationen 
iiberlappenden Daten aus den vorhergehenden Objektpositi- 
onsinformationen geloscht werden. 

Daraufhin schreitet das Prograrnm zu SI 08 fort, wo die 
neu erhaltenen Objektpositionsinformationen gelesen wer- 
den, d. h., die Daten des Objekts, die durch die Verarbeitung 
des durch das stereoskopische optische System 3 aufgenom- 



mcncn Bildes im Stereoskopbildvcrarbeiiungsabschnitt 11 
und im Objekterkennungsabschnitt 12 erhalten wurden. An- 
schlieBend schreitet das Prograrnm zu SI 09 tort, wo diese 
Daten zu der bei S107 gebildeten vorangehenden Objektpo- 

* si I ionsin formation addiert werden, urn sie v.u speichern. Die 
derart erhaltenen Objektpositionsinfonnationen sind aktua- 
lisierte neue Positionsinformationen uber urn das Fahrzeug 
angeordnete Objekte. Die bei den Schriiten S102 bis SI 08 
ausgefuhrten Verarbeitungen entsprechen den im Abschnitt 

to 13 zum Berechnen von Objektpositionsinformationen und 
im Speicherabschnitt 14 ausgefuhrten Verarbeitungen. 

AuBerdem schreitet das Prograrnm zu S 1 10 fort, bei dem 
die Moglichkeit einer Kollision des Fahrzeugs mit dem Ob- 
jekt basierend auf diesen aktualisierten neuen Positionsin- 

) 5 formationen uber um das Fahrzeug angeordnete Objekte un- 
ter Bezug auf die gespeicherte auBere Form des Fahrzeugs 
beurteilt wird. Daraufhin schreitet das Prograrnm zu Sill 
fort, wo gemaB dem Ergebnis der Beurteilung bei SI 10 ein 
Signal an den Anzeigeabschnitt 7 ausgegeben wird. Die bei 

20 S 1 10 und Sill ausgefuhrten Verarbeitungen entsprechen 
den im Abschnitt 20 zum Ausgeben des Ergebnisses einer 
Kollisionsbeurteilung ausgefuhrten Verarbeitungen. 

Die vorstehenden Positionsinformationen liber um das 
Fahrzeug angeordnete Objekte werden bei der nachsten 

25 Ausfuhrung des Programms als die vorangehenden Objekt- 
positionsinformationen eingelesen und verarbeitet. 

GemaB der ersten Ausfuhrungsform einer Fahrzeug-Run- 
dumobjekterkennungsvorrichtung 10 kann nicht nur die Po- 
sition von Objekten vor dem Fahrzeug erfaBt werden, son- 

30 dern es kann auch die Position von Objekten erkannt wer- 
den, die sich infolge derBewegung des Fahrzeugs neben das 
Fahrzeug bewegt haben. Daher kann durch das Fahrzeug- 
fahrtunterstutzungssystem, in dem diese Fahrzeug-Run- 
dumobjekterkennungsvorrichtung verwendet wird, die Be- 

35 dienung des Fahrzeugs durch den Fahrer uber einen weiten 
Bereich unterstutzt werden. 

Nachstehend wird eine zweite Ausfuhrungsform der vor- 
liegenden Erfindung unter Bezug auf die Fig. 8 bis 11 be- 
schrieben. 

40 GemaB Fig, 8 und 9 weist das Fahrtunterstutzungssystem 
2 einen Drehzahlsensor 5 fur das linke Hinterrad, einen 
Drehzahlsensor 25 fur das rechte Hinterrad, eine linke CCD- 
Kamera, eine rechte CCD-Kamera, eine Steuerungsvorrich- 
tung 6 und Anzeigeabschnitte 7FL bis 7S auf. Die Steue- 

45 rungsvorrichtung 6 weist auBerdem eine Fahrzeug-Run- 
dumobjekterkennungsvorrichtung 10 und einen Abschnitt 
20 zum Ausgeben des Ergebnisses einer Kollisionsbeurtei- 
lung auf. Die Fahrzeug-Rundumobjekterkennungsvorrich- 
tung 10 weist ferner einen Stereoskopbildverarbeitungsab- 

50 schnitt 11, einen Objekterkennungsabschnitt 12, einen Ab- 
schnitt 12 zum Berechnen von Objektpositionsinformatio- 
nen und einen Speicherabschnitt 14 auf. Der Abschnitt 26 
zum Berechnen von Objektpositionsinformationen berech- 
net basierend auf den Umdrehungszahlen des linken und des 

55 rechten Hinterrades und den im Speicherabschnitt 14 ge- 
speicherten vorangehenden Positionsinformationen iiber um 
das Fahrzeug angeordnete Objekte neue Positionsinforma- 
tionen uber um das Fahrzeug angeordnete Objekte und gibt 
diese an den Abschnitt 20 zum Ausgeben des Ergebnisses 

60 einer Kollisionsbeurteilung aus. 

Der Abschnitt 26 zum Berechnen von Objektpositionsin- 
formationen hat etwa die gleiche Funktion wie der im Zu- 
sammenhang mit der ersten Ausfuhrungsform beschriebene 
Abschnitt 13 zum Berechnen von Objektpositionsinforma- 

65 tionen. Im einzelnen wird die Verschiebung der vorangehen- 
den Objektpositionsinformationen folgendermaBen durch- 
gefiihrt. 

GemaB Fig. 5 verschiebt sich, wenn das Fahrzeug gerade- 
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a us fahrt, ein Objekt an einem Punki A i ya) zur Position 
B (Xb, yb). In diesem Fall verschiebi sich. weil der Fahrwert 
A ML des linken Hinterrades dern Fahrwert AMR des rech- 
ten Hinterrades gleich ist und ferncr x ;j = x h ist, eine durch 
Koordinaten (x 0 id, Yold) dargestellte vorangehende Objekt- 5 
position gemaB den beiden foigendcn Gleichungen zur 
durch Koordinaten (x ncw , y new ) dargesielltcn aktuellen neuen 
Objektposition: 

(15) 10 

y»iew = y D id - amr (16) 

Wenn das Fahrzeug dagegen eine Drehung ausfuhrt, be- 
wegt sich das Objekt am Punkt B (x b , y b ) zum Punkt C (x c , 15 
y c ). Der Drehmittelpunkt P c (X C e, Y C k) ^ird folgenderma- 
Ben dargestellt: 

X CE = (AMR + AML)/(AMR - AML) x (Spurweite)/2 (17) 

20 

Y CE = (Offset- Wert des Hinterrades) = 0 (18) 

AuBerdem wird der Drehwinkel 9 C von Punkt B zu Punkt 
C dargestellt durch: 

0c = (AMR - AML)/(Spurweite) (19) 25 

Daher wird die vorangehende Objektposition durch Erset- 
zen der Koordinaten (Xce, Y C e) und des Drehwinkels 0 C in 
den vorstehend erwahnten Gleichungen (13) und (14) auf 
die durch die Koordinaten (x new , y new ) dargestellte aktuelle 30 
neue Objektposition verschoben. 

Nachstehend wird eine Arbeitsweise der zweiten Ausfuh- 
rungsform eines Fahrtunterstutzungssy sterns 2 unter Bezug 
auf das in Fig, 11 dargestellte Ablaufdiag ramm beschrieben. 

Zunachst werden bei S201 die Fahrwerte AML und AMR 35 
des linken und des rechten Hinterrads vom linken bzw. vom 
rechten Hinterradsensor gelesen, und femer wird die voran- 
gehende Objektpositionsinformation vom Speicherabschnitt 
14 der Fahrzeug-Rundumobjekterkennungsvorrichtung 10 
gelesen. 

AnschlieBend schreitet das Programm zu S202 fort, wo 
gemaB den Fahrwerten AML und AMR festgestellt wird, ob 
das Fahrzeug eine Drehung ausfuhrt oder geradeaus fahrt. 
Wenn das Fahrzeug geradeaus fahrt, schreitet das Programm 
zu S203 fort, wo der Fahrwert AML zur vorangehenden Ob- 
jektpositionsinformation addiert wird. Wenn das Fahrzeug 
eine Drehung ausfuhrt, schreitet das Programm zu S204 
fort, wo der Drehmittelpunkt P c und der Drehwinkel 0 C be- 
rechnet werden, woraufhin bei S105 die vorangehende Ob- 
jektpositionsinformation um den Drehwinkel 9 C um den 
Drehmittelpunkt P c gedreht wird. Daraufhin schreitet das 
Programm von S203 oder S105 zu dem Schritt S 106 folgen- 
den Schritten fort, wo die gleichen Verarbeitungen ausge- 
fiihrt werden wie bei der ersten Ausfuhrungsforrn. 

Daher kann durch die bei der zweiten Ausfuhrungsforrn 
vorgesehene Fahrzeug-Rundurnobjekterkennungsvorrich- 
tung ohne Verwendung des Lenkwinkelsensors die gleiche 
Wirkung erzielt werden wie bei der ersten Ausfuhrungs- 
forrn. 

Die Fig. 12 bis 16 betreffen eine drit.te Ausfuhrungsforrn 
der vorliegenden Erfindung. Die Vorrichtung gemaB der 
dritten Ausfuhrungsforrn dient zum Ausfiihren von Steue- 
rungen fur einen autonomen Fahrbetrieb, wie beispielsweise 
einer Steuerung zum Anhalten des Fahrzeugs, zum Auswei- 
chen von Hindemissen und ahnlicher Steuerungen, basie- 
rend auf den von der in Verbindung rnit der zweiten Ausfuh- 
rungsforrn beschriebenen Fahrzeug-Rundumobjekterken- 
nungsvorrichtung 10 erhaltenen Objektpositionsinformatio- 
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nen. 

Bezugs/.eichen 30 bezeichnet ein autonorn lahrcnries 
Fahrzeug zum unbernannten Ausfiihren verschiedenartiger 
Arbeiten, wie beispielsweise zumReinigen von Borien. Ma- 
hen von Rasenfiachen und ahnlicher Arbeiten. Das amonorn 
fahrende Fahrzeug 30 weist eine Arbeitsvorrichiung 31, 
z. B. einen Maher, in der Nahe des hinteren Fahrzeugendes 
auf. AuBerdem weist es ein Paar Antriebsrader (linkes An- 
triebsrad 33L und rechtes Antriebsrad 33R) an der linken 
bzw. der rechten Seite des Mittelabschnitts des Fahrzeugs 
auf. Diese Antriebsrader werden durch Antriebsmotoren 34 
(linker Antriebsmotor 34L und rechter Antriebsmotor 34R) 
angetrieben, die durch eine Steuerungsvorrichtung 35 fur ei- 
nen autonomen Fahrbetrieb gesteuert werden. 

AuBerdem weist das autonorn fahrende Fahrzeug 30 ein 
stereoskopisches optisches System 3 (linke und rechte 
CCD-Kamera) zum Aufnehmen des vorderen Bildbereichs 
auf. Ferner sind ein linker Antriebsraddrehzahlsensor 5 zum 
Erfassen der Anzahl der Umdrehungen des linken Antriebs- 
rads 33L und ein rechter Antriebsraddrehzahlsensor 25 zum 
Erfassen der Anzahl der Umdrehungen des rechten An- 
triebsrads 33R vorgesehen. Das stereoskopische optische 
System 3, der linke Antriebsraddrehzahlsensor 5 und der 
rechte Antriebsraddrehzahlsensor 25 sind mit der Steue- 
rungsvorrichtung 35 fiir einen autonomen Fahrbetrieb ver- 
bunden. 

Die Steuerungsvorrichtung 35 fur einen autonomen Fahr- 
betrieb weist eine Fahrzeug-Rundumobjekterkennungs vor- 
richtung 10 auf, die die gleiche Funktion hat wie die bei der 
zweiten Ausfuhrungsforrn der vorliegenden Erfindung vor- 
gesehene Fahrzeug-Rundumobjekterkennungsvorrichtung, 
und einen Fahrtsteuerungsabschnitt 38 zum Ausfiihren von 
Steuerungen, wie beispielsweise einer Steuerung zum An- 
halten des Fahrzeugs, zum Ausweichen von Hindemissen 
und ahnlicher Steuerungen, basierend auf den Objektpositi- 
onsinformationen von der Fahrzeug-Rundumobjekterken- 
nungsvorrichtung 10. 

Wie in Fig. 15 dargestellt, sind die durch die Fahrzeug- 
Rundumobjekterkennungsvorrichtung 10 erzeugten Objekt- 
40 positionsinformationen Posidonsinformationen von Objek- 
ten, die in einem vorgegebenen Bereich QRST in der X-Y- 
. Ebene mit dem Fahrzeug als Mittelpunkt angeordnet sind. 
Im Fall einer Geradeausfahrt, wie beispielsweise einer Fahrt 
vom Punkt A (x a , y a ) zum Punkt B (Xb, yb), werden die 
45 neuen aktuellen Positionsinformationen gemaB den vorste- 
henden Gleichungen (15) und (16) berechnet. Andererseits 
werden im Fall einer Kurvenfahrt, wie beispielsweise bei ei- 
ner Fahrt vom Punkt B (x b , yb) zum Punkt C (x c , y c ), die 
neuen aktuellen Positionsinformationen durch die Gleichun- 
50 gen (13) und (14) erhalten. Die aus dem Speicherbereich 
uberlaufenden Daten und die mit den neu erhaltenen Daten 
uberlappenden Daten (Sichtfeld der Kamera) werden je- 
weiis geldscht. Durch Addieren der derart erhaltenen Daten 
zu den neu erhaltenen Daten (Sichtfeld der Kamera) werden 
55 die neuen aktuellen Objektpositionsinformationen erhalten. 
Im Fahrtsteuerungsabschnitt 38 wird basierend auf den 
vom Abschnitt 26 zum Berechnen von Objektpositionsin- 
formationen erhaltenen Positionsinformationen uber um das 
Fahrzeug angeordnete Objekte unter Bezug auf die gespei- 
60 cherte auBere Form des Fahrzeugs beurteilt, ob das Fahr- 
zeug angehalten werden sollte oder nicht. Wenn festgestellt 
wird, daB das Fahrzeug angehalten werden sollte, wird der 
Antriebsmotor 34 ausgeschaltet. Wenn festgestellt wird, daB 
das Fahrzeug dem Hindernis ausweichen kann, jedoch nicht. 
65 angehalten werden muB, wird einer der Antriebsmotoren 
34L, 34R an der dem Hindernis abgewandten Seite gesteu- 
ert, um dessen Drehgeschwindigkeit zu reduzieren. 

Nachstehend wird unter Bezug auf das in Fig. 1 6 darge- 
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stelhe Ablaufdiagramm eine durch die Steueru rigs vorric ti- 
tling 35 fur einen autonomen Fahrbetrieb ausgefuhrte auto- 
nome Fahnsteuerung beschrieben. Die Inhalte der Schritte 
S20 1 bis S 1 09 sind die gleichen wie die jenigen bei der zwei- 
ten Ausfuhrungsform, mit der Ausnahme, dafi anstelle von 
"Hinterrad" bei den Schritten S201 , S203 und S204 der Aus- 
druek "Antriebsrad" einzusetzen ist. 

Bei S301 wird basierend auf den vom Abschnitt 26 zum 
Berechnen von Objektpositionsinformationen erhaltenen 
Objektpositionsinformationen unter Bezug auf die gespei- 
cherte auBere Form des Fahrzeugs beurteilt, ob das Fahr- 
zeug angehalten werden sollte oder nicht. Wenn festgestellt 
wird, daB das Fahrzeug angehalten werden sollte, weil es in 
unrnittelbare Nahe eines Hindernisses kommt, schreitet das 
Programm zu S302 fort, wo der Antriebsmotor ausgeschal- 
tel wird (die Steuerung zum Anhalten des Fahrzeugs akti- 
viert wird), um das Fahrzeug anzuhalten. 

Wenn andererseits bei S301 festgestellt wird, daB das 
Fahrzeug nicht angehalten werden muB, schreitet das Pro- 
gramm zu S303 fort, wo die Steuerung zum Anhalten des 
Fahrzeugs deaktiviert wird. AnschlieBend wird bei S304 ba- 
sierend auf den vom Abschnitt 26 zum Berechnen von Ob- 
jektpositionsinformationen erhaltenen Objektpositionsin- 
formationen unter Bezug auf die gespeicherte auBere Fahr- 
zeugform beurteilt, ob das Fahrzeug einen Ausweichvor- 
gang ausfuhren sollte oder nicht. 

Wenn bei S3 04 festgestellt wird, daB dem Hindernis aus- 
gewichen werden sollte, schreitet das Programm zu S3 05 
fort, wo die Drehzahl des Motors an der dem Hindemis ab- 
gewandten Seite gesteuert wird (die Steuerung zum Auswei- 
chen eines Hindernisses aktiviert wird), um einen berechne- 
ten reduzierten Drehzahl wert zu erhalten, woraufhin das 
Programm beendet wird. AuBerdem setzt das Fahrzeug, 
wenn bei S304 festgestellt wird, daB dem Hindemis nicht 
ausgewichen werden muB, seine Fahrt fort. 

Dadurch konnen die Steuerungen fur einen autonorne 
Fahrbetrieb, wie beispielsweise eine Steuerung zum Anhal- 
ten des Fahrzeugs, zum Ausweichen von Hindernissen usw., 
effektiv ausgefuhrt werden, wenn das autonom fahrende 
Fahrzeug mit der Fahrzeug-Rundumobjekterkennungsvor- 
richtung 10 ausgerustet ist AuBerdem kann diese Fahrzeug- 
Rundumobjekterkennungsvorrichtung 10 fur ein autonom 
fahrendes Fahrzeug verwendet werden, das entlang Wanden 
oder wandahnlicher Objekte fahrt. Insbesondere wenn diese 
Vorrichtung fur einen Bodenreinigungsroboter verwendet 
wird, wird ein Arbeitsvorgang in unmitteibarer Nahe einer 
Wand einfach. 

Die Fig. 17 bis 21 betreffen eine vierte Ausfuhrungsform 
der vorliegenden Erflndung. Bei dieser Ausfuhrungsform ist 
die CCD-Kamera auf einem autonom fahrenden Fahrzeug 
40 drehbar angeordnet, um Bilder in einem breiteren Be- 
reich aufzunehmen. D. h., das stereoskopische optische Sy- 
stem 3 ist, wie in Fig. 17 und 18 dargestellt, auf einem Dreh- 
tisch 41 angeordnet, der in horizontaler Richtung schwenk- 
bar ist, um einen breiteren Objektinformationsbereich zu er- 
fassen. 

Der Drehtisch 41 ist mit einem Motor 42 verbunden, um 
den Drehwinkel des Drehtischs zu steuem. Der Drehwinkel 
a (wobei vorausgesetzt wird, daB der Drehwinkel in Ge- 
radeausrichtung 0 Grad betragt) wird durch einen Drehwin- 
kelsensor 43 erfaBt und dem Objekterkennungsabschnitt 48 
zugefuhrt, wie in. Fig. 17 dargestellt. Eine Fahrzeug-Run- 
dumobjekterkennungsvorrichtung 47 der Steuerungs vor- 
richtung 45 fur einen autonomen Fahrbetrieb hat mit Aus- 
nahme des bei der vierten Ausfuhrungsform vorgesehenen 
Objekterkennungsabschnitts 48 die gleiche Funktion wie die 
Fahrzeug-Rundumobjekterkennungsvorrichtung 10 der drit- 
ten Ausfuhrungsform. 



D. h., durch den Objekterkennungsabschniti 48 werden 
Parameter, wie beispielsweise die Position und die Form 
von Objekien auf der StraBe, aus dem vom Stereoskopbild- 
verarbeitungsubsehnitt 11 ausgegebenem Abstandsbild auf 
5 die gleiche Weise erhalten wie durch den Objekterken- 
nungsabschniu 12. AuBerdem berechnet der Objekterken- 
nungsabsehniu 48 Koordinaten eines in Fahrtrichtung erfaB- 
ten Objekis unier Bezug auf den Drehwinkel a des Dreh- 
tischs 41 und gibt diese Koordinaten des Objekts an den Ab- 
10 schnitt 26 zum Berechnen von Objektpositionsinformatio- 
nen aus. 

Wie in Fig. 20 dargestellt, mtissen bei dieser Ausfuh- 
rungsform, weil das durch das stereoskopische optische Sy- 
stem 3 erhaliene Bild um den Drehwinkel a von der Gerade- 

15 ausrichtung abweicht, die Koordinaten des Objekts korri- 
giert werden. Die korrigierte Objektpositionsin formation 
wird zu der in Geradeausrichtung erfaBten Positionsinfor- 
mation addiert. 

Im Fahristeuerungsabschnitt 46 wird die Fahrtsteuerung, 

20 z. B. eine Steuerung zum Anhalten des Fahrzeugs, zum 
Ausweichen von Hindernissen und ahnliche Steuerungen, 
basierend auf den Objektpositionsinformationen auf die 
gleiche Weise ausgefuhrt wie im Fahrtsteuerung s abschnitt 
38 der dritten Ausfuhrungsform der vorliegenden Erfin- 

25 dung. AuBerdem steuert der Fahrtsteuerung sab schnitt 46 
das stereoskopische optische System 3 so, daB es mit kon- 
stanter Geschwindigkeit nach links und nach rechts 
schwenkt. In diesem Fall kann die Bewegung des stereosko- 
pischen optischen Systems der Fahrzeugbewegung ange- 

30 paBt werden, so daB beispielsweise, wenn das Fahrzeug 
nach links dreht, das stereoskopische optische System 3 
nach links geschwenkt wird, und wenn das Fahrzeug nach 
rechts dreht, das stereoskopische optische System 3 nach 
rechts geschwenkt wird. 

35 . Der Steuerungsablauf in der Steuerungsvorrichtung 45 
fur einen autonomen Fahrbetrieb ist mit Ausnahme des Pro- 
grammschritts S401 der gleiche wie in der bei der dritten 
Ausfuhrungsform vorgesehenen Steuerungsvorrichtung 35 
fur einen autonomen Fahrbetrieb. 

40 D. h., nachdem die mit den neu erhaltenen Positionsinfor- 
mationen uberlappenden Daten bei S107 aus den vorange- 
henden Objektpositionsinformationen geloscht wurden, 
schreitet das Programm zu S401 fort, wo die mit dem Dreh- 
winkel a des Drehtischs 41 korrigierten neuen Objektpositi- 

45 onsinformationen gelesen werden, woraufhin das Programm 
zu S109 fortschreitet. 

Daher kann bei der vierten Ausfuhrungsform der vorlie- 
genden Erfindung, auBer dem bei der dritten Ausfuh- 
runsgform erhaltenen Effekt, ein breiter Sichtfeldbereich 

50 der Kamera erhalten werden, so daB das autonom fahrende 
Fahrzeug exaktere und kompliziertere Arbeiten ausfuhren 
kann. 

Bei den ersten bis vierten Ausfuhrungsformen der vorlie- 
genden Erfindung ist die Fahrzeug-Rundumobjekterken- 

55 nungsvorrichtung jeweils so aufgebaut, dafl Objekte um das 
Fahrzeug basierend auf durch die GCD-Kamera erfaBten 
Bildern erfaBt werden, wobei jedoch anstelle der GGD-Ka- 
mera andere Vorrichtungen, wie beispielsweise Laser-Ra- 
dar, ein Ultraschallsensor und ahnliche Vorrichtungen, ver- 

60 wendet werden konnen. 

AuBerdem wurde bei den vorstehenden Ausfiihrungsfor- 
men der vorliegenden Erfindung die Berechnung der Ob- 
jektpositionsinformationen bezuglich eines orthogonalen 
Koordinatensystems durchgefuhrt, wobei diese Berechnung 

65 jedoch auch bezugLich eines Polarkoordinatensystems 
durchgefiihrt werden kann. 

Zusammenfassend konnen erfindungsgemaB, weil die Po- 
sitionsinformationen uber urn das Fahrzeug angeordnete 
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Objekic permanent aktualisiert unci gcspeichert werden, 
wahrend das Fahrzeug fahrt, die Objekte in einem breiten 
Bereich urn das Fahrzeug erfaBt werden. ohne daB zusatzli- 
ehe Kameras, Sensoren und andere komplizierte Erfas- 
sungsvorrichtungen erforderiich sind. 5 

Patentanspriiche 

1 . Objekterkennungsvorrichtung fur ein Fahrzeug zum 
Erkennen von um das Fahrzeug angeordneten Objek- .10 
ten, mit einer Objekterfassungseinrichtung zum Erfas- 
sen einer Richtung von Objekten und einer Abstands- 
verteilung zu den Objekten und einer Objekterken- 
nungseinrichtung zum Erkennen der durch die Objekt- 
erfassungseinrichtung erfaBten Objekte als Hindemisse 15 
basierend auf der Abstandsvertei lung und zum Berech- 
nen einer Relativposition der Objekte bezuglich des 
Fahrzeugs, wobei die Objekterkennungsvorrichtung 
ferner aufweist: 

eine Objektpositionsspeichereinrichtung zum Spei- 20 
chern der Relativposition der Objekte bezuglich des 
Fahrzeugs; 

eine Einrichtung zum Berechnen eines Fahrwerts, der 
eine Fahrtstrecke und eine Fahrtrichtung des Fahrzeugs 
enthalt, wobei der Fahrwert basierend auf einem Lenk- 25 
winkel und der Radumlaufzahi, basierend auf der Um- 
laufzahl des linken und des rechten Hinterrades und/ 
oder basierend auf der Radumlaufzahi und einer um ei- 
nen Winkel verschwenkbaren Objekterfassungsein- 
richtung ermittelbar ist; und 30 
eine Einrichtung zum Berechnen von Objektpositions- 
informationen zum Berechnen einer neuen Relativpo- 
sition der Objekte bezuglich des Fahrzeugs basierend 
auf der Relativposition der Objekte und dem Fahrwert 
des Fahrzeugs und zum Aktualisieren der in der Ob- 35 
jektpositionsspeichereinrichtung gespeicherten Rela- 
tivposition durch die neue Relativposition der Objekte, 
um die Objekte erkennen zu konnen, die einen Erfas- 
sungsbereich der Objekterfassungseinrichtung verfas- 
sen haben. 40 

2. Vorrichtung nach Anspruch 1 , wobei die Objekter- 
fassungseinrichtung aufweist: eine Einrichtung zum 
Aufnehmen eines Stereoskopbildes der Objekte durch 
eine in eine Vorwartsrichtung des Fahrzeugs ausgerich- 
tete Abbildungseinrichtung und zum Berechnen einer 45 
dreidimensionalen Abstandsvertei lung basierend auf 
dem Stereoskopbild. 

3. Vorrichtung nach Anspruch 1 oder 2, wobei die Ob- 
jekterfassungseinrichtung aufweist: eine Einrichtung 
zum Aufnehmen eines Stereoskopbildes der Objekte 50 
durch eine um einen Winkel bezuglich der Vorwarts- 
richtung des Fahrzeugs gedreht.e Abbildungseinrich- 
tung, zum Berechnen einer dreidimensionalen Ab- 
standsverteilung basierend auf dem Stereoskopbild und 
zum Korrigieren der dreidimensionalen Abstandsver- 55 
teilung gemafi dem Winkel. 

4. Vorrichtung nach Anspruch 3, wobei der Winkel mit 
konstanter Geschwindigkeit in die linke und in die 
rechte Richtung geandert wird. 

5. Vorrichtung nach Anspruch, 3 oder 4, wobei der 60 
Winkel in die linke Richtung geandert wird, wenn das 
Fahrzeug eine Linksdrehung ausfuhrt, und in die rechte 
Richtung, wenn das Fahrzeug eine Rechtsdrehung aus- 
fuhrt. 

6. Objekterkennungsvorrichtung nach Anspruch 2, . 65 
wobei die Abbildungseinrichtung ein Paar von auf dem 
Fahrzeug angeordneten CCD- Kameras ist. 

7. Vorrichtung nach einem der Anspriiche 3 bis 6, wo : 
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bei die Abbildungseinrichtung ein Paar von auf dent 
Fahrzeug drehbar angeordneten CCD-Kameras ist. 
8. Verlahren zum Erkennen von um ein Fahrzeug an- 
geordneten Objekten mit einer Objekterfassungsein- 
richtung /.um Erfassen einer Richtung von Objekten 
und einer Abstandsverteilung zu den Objekten und ei- 
ner Objekierkennungseinrichtung zum Erkennen der 
Objekte als Hindemisse basierend auf der Abstands- 
verteilung und zum Berechnen einer Relativposition 
der Objekte bezuglich des Fahrzeugs, mit den Schrit- 
ten: 

Speichern der Relativposition der Objekte bezuglich 
des Fahrzeugs; 

Berechnen eines Fahrwertes, der eine Fahrstrecke und 
eine Fahrtrichtung des Fahrzeugs enthalt, wobei der 
Fahrwert basierend auf einem Lenkwinkel und der 
Radumlaufzahi. basierend auf der Umlaufzahl des lin- 
ken und des rechten Hinterrades und/oder basierend 
auf der Radumlaufzahi und einer um einen Winkel ver- 
schwenkbaren Objekterfassungseirtrichtung ermittel- 
bar ist; und 

Berechnen einer neuen Relativposition der Objekte be- 
ziiglich des Fahrzeugs basierend auf der Relativposi- 
tion der Objekte und dem Fahrwert des Fahrzeugs und 
Aktualisieren der in der Objektpositionsspeicherein- 
richtung gespeicherten Relativposition durch die neue 
Relativposition der Objekte. 
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